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1. INTRODUCTION 


In determining the performance, by simulation methods, of a 
missile system designed to intercept moving targets, it is frequently 
: necessary to generate the trajectory of the targets during the course 
of complicated maneuvers. Various possibilities exist for expressing 
i the target trajectories without resorting to a full numerical solution 
of the target dynamic equations which would require complete knowledge 
of all the ferces acting on the target. 


Target trajectories can be expressed deterministically in terms of 
position, velocity, or acceleration components es functions of time 
with respect to a particular frame of reference. It is only necessary 
to use one cf these formulations since the cthers are obtainable either 
by integration or differentiation. Whichever form is used, an inter- 
polation process is usually required since typical maneuvers are not 
expressible in terms of simple algebraic functions but must, in general, 
be represented as arbitrary tabulated furctions of time. It is 
important that the fnaterpolation process maintain mathematical continuity 
of at least carget position and velocity since discontinuities in either 
of these parameters could have deleterious effects in a simulation. A 
typical example is the effect on simulations containing recursive target 
tracking filters in a digital tracking signal processor. A further 
requirement of the trajectory generation procedure is that it be com- 
putationally efficient with respect to computer time usage. This is an 
aspect of particular importance in simulations based on Monte Carlo 
sampling since this type tends to consume large amounts of computer 
time and a relatively small time reduction in each sample run can 
produce stgnificant overall savings. 


This report describes a method of trajectory generation which is 
designed to satisfy the requirements outlined in the foregoing. It is 
based on fitting a series of cubic splines in a piecewise manner to a 
set of coordinates describing the position of the target body at 
discrete points in time. The use of cubic splines implies that a third 
order polynomial is fitted between the discrete time points, and that 
; continuity of first and second derivatives is maintained at the break- 

* pointa. In this way the technique ensures continuity of position, 
velocity, and acceleration. Calculation of the polynomial interpolation 
coefficients is performed offline to the simulation and then input and 
stored by the simulation program. At any point in the course of the 
simulation the target position, velociry, and acceleration cre available 
by the evaluation of third, second, and first order polynomials 
respectively, one set for each trajectory component. 


This report includes a description of a computer program which 
performs the offline calculation of interpolation coefficients with the 
added facility that the input target trajectory may be specified in 
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terms of position, acceleration, or flight path angles at discrete 

time points. Target position data input is a particularly useful option 
when tast range measured positiors in an actual trajectory are required 
to be input; accelerations are required to be specified in a target- 
fixed frame based on the target velocity vector direction. 


In addition to the target trajectory in terms of the kinematic 
parameters, it is often necessary to know the orientation of tha 
target. This ia particularly the case when detailed radar models are 
used which depend on target aspect angles relative to the radar 
antenna. The computer program contains an option to calculate the 
interpolation coefficients for three Euler angles in the same manner 
as for the trajectory position. The Euler angle representation 
includes the effect of target aerodynamic angle of attack, provided 
the requisite input data concerning target lift curve and wing loading 
are aupplied. 


it. TRAJECTORY REPRESENTATION 


Qutput trajectories, expressed in terms of spline iaterpola- 
tion coefficients as functions of time, are defined relative to the 
Cartesian axes of an inertial frame which has its origin at a point 
on the earth's surface. Input data to the trajectory calculation are 
expressed optionally in one of three forms, two of which employ a 
reference frame defined by the body velocity vector. The various 
> reference frames are described tn the following peregraphs. 


A. Input Reference Frame 


This is an orthcgonal, right-handed Cartesian frame 
with the origin at an arbitrary reference point on the earth's surface. 
The X and Y axes lie in the plane of the local horizontal, and the Z 
axis ia along the downward vertical. Input data to the trajectory 
calculation which are referenced to an inertial frame use this frame. 
Those input data included in this classification are the position 
coordinates in cption 1 and the initial position and velocity components 
of opticas 2 and 3 (see Section IV for descriptions of these options). 


B. Output Inertiai Frame 


The output inertial frame is also an orthogonal, right- 
handed Cartesian system and is related to the input inertial frame, 
in general, by a translation and a rotation. The translation represents 
the displacement vector Xo of the output frame origin relative to the 
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input frame, and the rotation is expressed in terms of three Euler 
angles Yo> 85» 99 through which the input frame rotates in order to 
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align itself with the output frame. The relationship of the two frames 
is shown in Figure 1, and the angular rotations in going from the input 
frame to the output frame are shown in Figure 2. In mathematical terms 
the transformation equation is 


Sout ” (T] oy (lan ; Eo} (1) 


where (T]oy is the matrix of direction cosines of the output frame 


relative to the input frame, and are vectors expressed 


r,,f 
~in’ out 
respectively relative to the input and output frames. Expansion of 
(T]os into its components gives 


Th = cos oy cos 85 

To) = ¢o8 Yo sin 8% sin $6 - sin Vo COs $6 
T3) = cos vo sin 8 cos y + sin Vo sin $6 
Ty = sin Yo cos 85 

To ™ cos Vo ccs % + sin Vo sin Q% sin $9 
T32 = sin Vo sin 8 cos to - cos Vy sin %% 
T13 = -sin 8% 


T53 = cos 8% sin %% 


T33 = cos 85 cos 9 


Cc. Vehicle Velocity Frame 
The vehicle velocity frame is a noninertial Cartesian 
axis system in which the positive x, axis is directed along the body 
velocity vector. The Y, axis is directed horizontally to the right 
when looking from the origin along X» and the zy axis is normal to the 
xX, - YX, plane and thus lies in a vertical plane through the velocity 
vector. 
In relation to the input inertial frame, the velocity frame is 
obtained py a rotation Yep about the input inertial frame Z axis, and 


a rotation @,, about the new Y axis position. Origin of the velocity 


T 
frame lies at the CG of the body. Figure 3 illustrates the velocity 
frame and its relationship to the input inertial frame. 
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Figure 1. Input and output inertial frame. 


Figure 2. Input-output frame angular rotations. 
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Figure 3. Orientation of velocity frame relative to input frame. 


Trajectory specification options 2 and 3 express the body acceler- 
ation in this frame. Acceleration components determine the rotational 
f rate components Ve and oy which are integrated to give the orientation 


of the body velocity frame to the input inertial frame. Let the 
acceleration components in the velocity frame be A. y A y’ Ay? and 
let the vehicle velocity be V, then y 


(2) 


> 


(3) 


3 


a ”) 


from which velocity components in the input inertial frame are 


Vyy 7 ¥ cos 0, cos ¥, (5) 
Vy; 7 V cos 6, sin y,, (6) 
Ve 7 7V sine, - (7) 


These velocity components are integrated to yield the position of the 
body as a function of time from the given initial position and velocity. 
Initial position and velocity components are expressed relative to the 


E input inertial frame. If the initial velocity components relative 


to the input frame are Vie Yyt0 Voice’ then 


Vv 
Vote A tan72 (722) (8) 
XIC 
and 
-V 
i eee ee (9) 
2 2 2 


Yxic * Yyre * Yz1e 


ii. CUBIC SPLINE INTERPOLATION 


This section contains a brief outline of the underlying theory 
of curve fitting by means of cubic splines. A more detailed analysis is 


i given by Schultz.? 
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schultz, Martin H., Spline Analysis, Prentice-Hall, Inc., 
Englewood Cliffs, New Jersey, 1973. 
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The fitting of smooth curves to function values given at discrete 
intervals of an independent variable has received considerable atten- 
tion im the past. A well-known procedure is that due to Lagrange in 


which an yeh order polynomial is fitted to N + 1 function values. 
However, it ts also well~known that for values of N of moderate size 
and iarger, the procedure can diverge and produce highly unsatisfactory 


results. 


The modern approach to curve fitting has received much impetus from 
finite element techniques and has led to the use of piecewise polynomial 
fitting with constraints on the derivatives at the end points of each 
interval. A requirement fer continuity of first derivatives at the 
interval end points yields a set of interpolating polynomials which 
are "local" {in the sense that each polynomial depends only on the 
independent variable and function values at the end points of each 
interval, As such, it is an extension of the method of piecewise lineax 
interpolation which is in common use. This technique, using cubic 
polynomials, is described as follows. It she.1ld be noted that although 
cubic polynomials are often used, the procedure can readily be general- 
ized to higher order polynomials, 


Consider a set of N + 2 real numbers Xo < x) < %» Newaw << xy +1 


and an associated set of function values {£55 fi) i= 0, 1, 2, ...,N+1 


where the prime superscript implies differentiation with respect to x. 
Let p(x) be a cubic polynomial such that p(x,) = fio p(x, + D - f, +1? 


= ' m ’ . 
dp (x, )/dx fi and dp (x, + 1) / ax fi er Also let the interpolated 


value of f be F; then F may be expressed as 


F= (fh, (x) + £ihy (x) } (10) 


where hy (x) and hy (x) are basis" functions of x with the following 


properties: 


hy (xj) = 5, O< ij <Ntl (11) 


*Hesming, Richard W., Introduction to Applied Numerical Analysis, 


McGraw-Hill Book Company, New York, 1971, pp. 146-163. 
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S yy is the Kronecker delta function. For i= 1, 2, 3, ..., N 


2 
(x- x, _ 1) 


2 
C(x = x) Ce = xy D 


x 
2 i-1- 
(x, ~ XL D 
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(x, a x5)? o- 1 : 
' = 
hy (x) (17) 
~ 0 2 * S41 : 
and for i= N+1 \ 
2 
(x - x) 2(x - Xy) \ 
Co +17 "N ee SS ye 
by + 1) = 
0 Oc x< x : 
(18) é 
(x - x)? Ge - x 4 
ee . y? *N =e yy +1 
Vy 41 7 ON 
hy 4 1 © 
0 O<x< O° 
(19) 
Expanding Equation (10) for the case of x KK X; 4. 1 8ives ; 
£ f . 2 
te ( - x,)? aan x;) 
pe 7 *1 
(x - x,) 2 
5 oe i 1 FG gO yD em DD (20) 
en 7% 


If a piecewise independent variable is written Ax, where Ax © x - x 


i’ 
i+l 
i 


then a piecewise cubic polynomial may be defined for K,ix<x 
as 


2 


; 3 
p(dx), = a. + atx * a,Ax” + aidx ; (21) 


0 l 2 


and the coefficients are obtained frum Equation (20) as 


ay * fy (22) 
- ' 
a, fi (23) 
ea t ' 
3(fp 447 £) 28 t Egy 
a2 7 haar ear ee Sa 
(x, ro ¥ 4) i+l 1 
~2(£ - f,) fl +f 
a," i+1 are 4+41 (25) 


In many cases the derivatives f 


2 
(xy 4 7X) (x, 44 7%) 


' of the function f are not avail- 


able and it bec.mes necessary to appreximate them from values of fi 


A method of performing this approximation is to use local cubic 
Lagrange interpolation polynomials to fit a curve through groups of 
four points and obtain fi from these polynomials. The procedure is 


described as follows. Let the Lagrange polynomials be r(x) defined by 


3 
r(x) = 3 Meare) fag 
i=0 
where 
3 
I 
j= 0 (x- x 4 > 
ai 
ye Sraq ——_ 
I ( 
p= 0 Mee Key 
jet 


(for N > 2) (26) 


(27) 
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which interpolates f. 4 for i= 0, 1, 2, 3. Derivatives of f may 


then be approximated as follows: 


df (x, ) 
bogs ted LI “ek : 
fi dx 2 ‘3 (x,_ 2) +S (rep) 2sisne-i 


5 (ry 2(x,)) +N 
& (r, 7 3(%,)) i=N4+1 ; (28) 


The term “spline interpolation" implies the fitting of polynomials 
in a piecewise manner as described but with the added constraint that 
second and higher derivatives of the function are given continuity at 
the interval end points, thus simulating the effect of forcing a thin, 
flexible spline to pass through the function points. The physical 
procees of clamping aspline to a certain number of function values is 
one that is commonly used in naval architecture and shin design. For 
the purposes of this report, the spline functions considered will be 
restricted to cubic polynomials and only second derivatives will be 


equated at interval end points. The general case of ae order poly- 
nomials used is often referred to as B-spline fitting. 


To illustrate the cubic spline interpolation process, consider 
again the set of function values fy corresponding to a set of 


independent variable breakpoints Xs» Z= 0, 1, 2, ..., N#1. Let 


p(x) be the cubic interpolating polynomial for the interval 


Xpip ££ and let q(x) be the cubic interpolating polynomial for 
the interval Ky SX SX yy with the following properties for 


Ll< i<N 


p(x,) = a(x,) = fy (29) 


oe 
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4 ss = cs w f' 
F PF p(x.) ™ aX q(x,) fio (30) 


Using Equation (20), the polynomials p(x) and q(x) may be exnanded about 
the point Ky to give 


[p(x,; . tae p(x,)] ‘ 


p(x) = p(x,) + Dp (x, ) (x - x,) + te - 


2 
(x - x,) 
acs es a 00a) cs 


2 
+ bie sen (p(x, . 4) - p(x,)] + Dp(x, _ » 


3 
(x - x) 
+ rota : ; 5 (31) 
ae ee | 
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rt 
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q(x) = q(x,) + Dq(x,) (x - x,) + ie (qty 4 »-* q(x] 


2 
(x - x,) 
+ Da(xy 4 1) + Daley)? GET 


2 
+ 2 (aC 4 p 7 q(x,)] + Dq(x, 4 D 


(x - x,)° 
+ 2Dq(x,)¢ ——3 , (32) 
Ax, 


where 
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The requirement for continuity of second derivatives at the point Xx, is 
2 2 
D p(x, ) =D q(x,) (33) 
and by analogy with the Taylor Series expansion about Xyo then 


D*pix,) - ae \gt (p(x, _ 4) - p(x] 


+ Dp(x, _ ,) + 00a (34) 
D*4(x,) . oF I fax, 4 4) - 4G0,)] 
+ Dq (x, = D + raat (35) 


which leads to the requirement 


e ? t 
Ax,f5 | + afi (4x, + Ax, ie » + Ax, ~1 fi #1 


+ —— eof Leis<N. (36) 


Equation (36) represents a set of N linear equations in fi which may 
be written in vector form as 


[Blfi ac l< i,j <N (37) 


where the matrix [By] is given by 
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2(ax, + 4, _ 4) l<i jen 
Ax lec jJrin-1leN-l 


Biy 2 (38) 
<jritilen 


0 otherwise 


of) 1 “fo 
5 ge et iu 
Ax, Ax 1°0 
Ax Af Ax, Af 
c, = ¢ 3 i <= 4 = i=l L<ic<n (39) 
4 eief 
3) aa “tn, AE ad mf cate 
Ax, ay. 1 ad Nts 
where 
Be pea Fy 
ee eee 


As can be observed from definition Equation (38), the matrix Bay is 


tridiagonal and it can be shown” that the system of Equations (37) 
has a unique solution; in fact, Equations (37) can be readily solved 
by Gaussian elimination. 


Interpolated function values are then obtained by substituting 
in Equation (10), yielding the interpolant F as 


N+1 ' N 
Fe SY typo + egngao + So £phyGo + fay hh (40) 
i=0 ie-l 


3schultz, loc. cit. 
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where fi (4 = 1, 2, ..-, N) have been obtained from the solution of 


Equations (37). Note that F is no longer a "local" inrerpolating 
function since all fy are used in obtaining fie Piecewise polynomial 


interpolation coefficients are given by Equations (22) through (25). 


It remains only to choose a method of calculating the extremity 


derivatives fo and fy eL These derivatives may be obtained from 


local cubic Lagrange polynomials at k = 0 and k = N —- 2 as given in 
Equations (17) and (18), i.e., 


3 
rox) = Sng Oo fy (41) 
1=0 
3 
Ty 2) > My - 2,10) fy 24d (42) 
i= 0 
and the derivatives fo and fy + 1 are approximated as 

t = 

f= Dry (xp) (43) 
a) a : 
oe a ea ae 


An example of cubic spline curve fitting is contained in Figure 4, 
in which function values are indicated at the appropriate breakpoints 
in x, and the full line is that obtained by the spline interpolation 
process. 


IV. TRAJECTORY GENERATION 


The input data to the trajectory generation program may be 
specified in one of three ways, chosen at the option of the user. 
These options are described in the following paragraphs. All three 
options require that the origin translation and frame rotation of the 
output frame relative to the input frame be specified. For options 
2 and 3, initial body position and velocity relative to the input 
frame must be included in the data. 
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Figure 4. 
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A. Option 1 - Position Input ' 


For this case the input data consists of sets of values 
of body position coordinates relative to the input reference frame and 
an associated value of time. Data sets should cover the time span of 
the trajectory at intervals demanded by the rates of change of 
trajectory parameters. 


B. Option 2 ~ Acceleration Input 


Applied acceleration components in the body velocity 
frame are specified as arbitrary functions of time over the required 
time span of the trajecvory. The acceleration functicns are required 
to be specified in units of local gravitational acceleration, and 
the local gravity is related to sea level gravity (assuming a spherical 
earth) by 


Ry 7 
B= 8 \Ro +H 2) 


[2 2 2 
H = x + yy + (Ry = Z1) - Ry (46) 


where Bo is mean sea-level gravity acceleration, Ry is the mean radius 

I are body coordinates relative to the input 2 
reference frame, and H is the body altitude above the earth's surface. : 
Derivation of Equation (46) is readily apparent from Figure 5. ‘ 


of the earth, Xr Yio Z 


The body trajectory is obtained by integrating the kinematic 
equations to give position coordinates, as indicated by Equations (2) 
through (7). Acceleration functions are assumed to be continuous 
between the specified data points; linear interpolation in the functions 
is used to obtain intermediate acceleration values. 


Cc. Option 3 - Flight Path Angle Input 


Fer option 3 input data are specified by expressing 
flight path angles Vr and oo as arbitrary functions of time, together 


with the longitudinal acceleration in the velocity frame as a function | 


of time. The changes in flight path angles between consecutive pairs | 
of time breakpoints are converted to equivalent accelerations and the 
body trajectcry is cbtained as in option 2. For this case, however, 
the acceleration is assumed to be constant between adjacent pairs of 


time breakpoints, and to change discontinuously at each breakpoinr. 
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Figure 5. Vehicle altitude above earth's surface. 


Dd. Trajectory Interpolation 


Program output consists of sets of polynomial coefficients 
at discrete time points contained within the input data. The polynomial 
coefficients generate the vehicle position as a function of time in the 
following manner. Let t be the current time and let the discrete time 
breakpoints be to < ty < t, eae < tye and let At =t - ty for some 


0 < i < N where t,<t< ty yg ys then 


| : 2 3 
. i Xp a + a, dt + ajdt +aydt (47) : 


where Xo is the X coordinate of vehicle position relative to the outpur 
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reference frame and Ag: Gy» ao, a, are the polynomial coefficients for 


the X coordinate within the time interval t, tot 


i Coordinates 
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¥ and Z are generated by similar sets of coefficients. Coefficients 
are calculated for time intervals from ty to tye thus there are N sets 


of coefficients for the N + 1 breakpoints. 


Velocity and acceleration components are generated by differentia- 
tion, i.e., 


2 
V0 a, + Za,dt + 3a,hc (48) 


dt (49) 


* 3 


ae ™ 2a, + 6a 


From the above it can be seen that the interpolation process 
consists simply of determining i for a given value of ¢ and evaluating 
Equations (47), (48), and (49) to obtain the vehicle trajectory. In 
simulation applications t is inevitably monotonically increasing, 
which makes the determination of i a simple matrer and avoids extensive 
searching of the table of time breakpoints. 


V. VEHICLE EULERIAN ANGLES 


The Euler angles of the vehicle with respect to the output 
reference frame are expressed in the same form as the final output 
trajectory, i.e., as sets of spline interpolation coefficients at 
discrete intervals in time. An option in the calculation permits the 
inclusion of aerodynamic angles of attack under the assumption that 
the vehicle is air~-supported by fixed wings and that all maneuvering 
turns are coordinated. That is, the body sideslip angle is always 


zero, 


Euler angles of the vehicle with respect tc the output reference 
frame are defined by three rotations required to align the output frame 
with a vehicle-fixed frame. The rotations are VR about the Z t axis, 

ou 


Oo, about the resultant position of the : axis, and op about the 


t 
vehicle X axis, 


The vehicle velocity frame relative to the output reference frame 
has angles Vrg and Pn defined similarly to Vr and 6,, for the input 


frame. However, Yr and 8x6 are calculated from velocity components 


relative to the output reference frame obtained by differentiating 

the cubic spline representation of the trajectory, as indicated in 
Seciion IV. If the vehicle velocity components relative to the output 
frame are Vi0° Yo" V.0° then 


-1 [ “yo 
rg * tan v (50) 
x0 
-v 
fie gin) aes . (51) 
10 2 2 2 
Veg t No0'* Veo 


To perform a coordinated turn, a roll angle about the velocity 
vector is required in order to maintain a balance of forces, as 
indicated in Figure 6 which shows that the lift generated normal to the 
velocity vector must provide the force to support the body and provide 
the forces to produce the lateral accelerations. It is assumed that 
acceleration along the velocity vector is produced by external forces 
such as engine thrust and aerodynamic drag. The gravitational acceler- 
ation acts along the Zon axis and, therefore, transforming to the 


output frame the gravitational acceleration is 


Q 
Bo = [T]h, |] 9 (52) 
8 
which expands to 
a = 5 
8,0 g sin 85 (53) 
= f 
Big 7 8 cos 8, sin o> (54) 
Bio ™ 8 COS 8) cos oy (55) 


The body acceleration, represented by the trajectory interpolation 


coefficients, is Ay relative to the output frame. For the force 


balance of Figure 6, this must be transformed to the body velocity 
frame through the angles veo and 89° The lateral acceleration terms 


in the velocity frame are thus 


(56) 


" A = -A sin Viro + Avo cos Viro 


yv0 x0 


22 


Figure 6. Vehicle lateral force balance. 


A = A cos Vro sin 850 + Avo sin Yro sin 6 


zvO x0 A,0 eo 8 


to * TO 


(57) 


and the gravitational acceleration transformed to the body frame is, 
in the lateral directions 


Byyp 7 8x0 919 Yn * Byp 59% Yao or 


8 .y0 = 8.0 cos Yro sin Srp +g sin Yr sin 6,, + 89 68 8 


yO TO 


TO 
(59) 


2V 
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where A_,, A_., A_, are components of A, in the output frame. The 

x0’ “yQ* “20 —~0 
vehicle lift force L must previde a component along Z,, which has a 
resultant acceleration of A,vo and a horizontal. component which has a 
resultant acceleration of Ayo with L acting normal to the vehicle 
wingspan and velocity vector. Thus, the vehicle bank angle is given 
by 


= A -— 8 
dro = tan : (228 | (60) 
zv0 zv0 


and the lift force L is given by 


W / 2 2 
Ls g (Avo = By yo) (82y0 7 A2vo : (61) 


where W is the vehicle weight. ‘Note that in Equation (60) if both 
numerator and denominator are zero, dnp is undefined since this would 


be the case of the body falling freely under gravity, A further point 
to be cerefully considered concerns the definition of the vehicle 
velocity frame. If 89 #0 or $9 #0, then the velocity frames obtained 


by rotating Va? 8p from the input reference frame and Ying? 80 from 


the output reference frame will differ by an apparent roll angle, as 
can be deduced from Equation (58) in which the Yy axis has a gravita~ 


tional component acting along it. For this reason the acceleration 
components Avo and AjvO are, in general, not equal respectively to 


A and A_ of Section II. 
yv zv 


If it is assumed that the lift curve for the vehicle can be 
approximated by the form given in Figure 7 and is an odd function 
about a = 0, the angle of attack can be approximated by first 
calculating the vehicle lift coefficient as 
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e ms 
a 
: Figure 7. Idealized lift curve slope. * 
where W/S is the vehicle wing loading, p is the ambient air density, 4 
and V is the vehicle total speed. The angle of attack is then 4 
° & lice 
(2) =97 | 
a= da 1 ‘dC, (63) q 
Cc, -a,{(—— f 
L 1 ( ah 4 
a ers | aa a>a 4 
jE 1 (= ane 4 4 
: da V9 


9 is a function of vehicle altitude H, where H is given by Equation (46) 


in which xy» ty» zy are referenced to the input frame. Thus, for 


position coordinates referenced to the output frame, K must be deter- 
mined by a tcsansformation of the trajectory coordinates to the input 
reference frame. Lift curve parameters Qs» (dC, /da),> and (dC, /da), 


ao neeemeenminetaageene mieten eam 


VETTE EY PTE UAE LOOT ERAIT e282 TILER ARTE A TY PEM SN TRUNN TD apepaer cee ee te eo regrumate 


are illustrated in Figure 7. Notes that a as defined by Equation (63) 
is always positive. A set of rotations from the output reference 


frame to the vehicle fixed frame is vero? Sno» bro? Gn where 
i tf (8.40 ~ Avo? = 
tag ™ 94) 
aS og (8240 . 40 ve 


These rotations may be expressed as a set of matrix products to form 
a transformation matrix of direction cosines which rotates the output 
reference frame to the vehicle fixed frame as follows: 


(gg = Te Me ite, Ite I (65) 


where 
(66) 
(67) 


| 
| . 


(69) 
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The transformation matrix [Tyo is equivalent to a matrix of 


direction cosines formed from the Euler argies Vig» Ope and ope The 


direction cosine matrix contains elements of the same form as that 
given for the expansion of (Tloy (Paragraph II.B) with Ver Sy op 


substituted for Vor Qo» to: By inspection of the terms in the 
expansion of [T] oy the Euler angles are given by 


ae ee fannie oR 6 ae en ag tt 
SiS Cpe stn RS a TRADE 6 Peal 


t 
Vp ” tant (22 (70) 
1 / 
6, = sin’ (-t,.) (71) 
13 
t 
o, 7 tan” te (72) 
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where tio» 14> ty3> t33 are elements of the matrix (T] yo: Evaluating 


these terms from Equations (66) through (69), the vehicle Fuler angles 
are 


cos no sin Yr cos I - sin ®n9 cos Vr cos bro sin eg 


v, * tan = ha ns sini em Susser 
B COB Ory COB Ving C08 O49 Sin by Sin 4,9 sina,» 
(73) 
-1 2 
ep = gin (sin 2n9 COB Ay9 + cos 870 cos oro sin Yao) (74) 
os ~ tan os @ cos ¢ —— =r = ;70 rt (75) 
COS Cp COB bpp COS Ong n 8,9 sin Gey 


It should be noted that if the vehicle angle of attack is negligible, 4 

then Euler angles are easily deducible from the trajectory interpolation : 

4 coefficients vie the first and second derivatives of the interpolating 
: polynomial and Equations (50), (51), and (60). In this case the 

a calculation of Euler angle interpolation coefficients is unnecessary. 

¢ 

bt 


A further consideration in the calculation of polynomial inter- | 
polation coefficients for the Euler angles concerns the range of 
values taken by the Euler angles themselves, Equations (73) and (75) 
normally yield principal values of the angles, f.e., in the range iI. 
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Thus, when the angles pags from a value close to fl to one close to 

~_ the spline fitting process will assume that the angle has passed 

through zero giving rise to incorrect results. To counteract this 

effect, the range of velues taken by the angle must be extended by 

converting the principal values to 0 to 2M and permitting the angle 

to go beyond this range by adding or subtracting 21 when the angle 

crosses from the fourth to the first quadrant or from first to the 

fourth quadrant. ‘ 


This calculation is described as follows: 


vg + 2nt vp 20 
Var = (76) 
(20 + ¥p) + 2nii Vy <0 


where Vee is the extended Euler angle and n is determined by maintaining 


a record of the firerffourth quadrant crossings as Ye varies with 
time. To illustrate this, let the index of discrete time points at 
which trajectory data are given be i which takes values of 1 = l, 


2, «ve, k for k breakpoints, then 


n= 0 for i«1 (77) 
Ay, =" ~ (78) 
pe as as Ge WR ee a ee 
a= n+i when Wp < <1 (79) 
4, 
n=n- 1 when Sv, > (80) 


1 


This process is applied to the calculation of Ve eince this Euler 


angle is most likely to require extension beyond principal values. It 
should be recognized that the Euler angle calculation contains 
limitations on the range of 9, to +/2 and op to +f, and thac o, is 


calculated by assuming that the vehicle makes coordinated turns. 


Vi. COMPUTER PROGRAM 


4A cowputer program has been written to generate the sets of 
spline interpolation coefficients which represent a vehicle trajectory be 
and the corresponding Euler angles. The program is intended for use in pat 
an offline mode where the trajectory coefficients are punched on cards 
or written to some other peripheral device for use in a missile-target 
intercept simulation which requires a moving target. 
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All three options described in Section IV are included in the 
program. The user selects a desired option via the program's input 
data. The program is written in FORTRAN for a CDC 6600 series machine. 
A listing is contained in Appendix A. 


A. Program Composition 


The program consists of the main program which performs 
the input/output operations, calculates accelerations and angle of 
attack, perforns coordinate frame transformation, and controls the 
overall operat:ion and the following subroutines: 


1) AVELIN — Calculates cubic spline interpolation 
coefficients for three functions of one independent variable. 


2) RK4 — Performs Runge-Kutta fourth order integraticn 
of velocity frame rotational rates, longitudinal acceleration, and 
inertial frame velocities. 


3) ATTAK — Interpolates in a trajectory using coeffi- 
cients produced by AVELIN. First and second derivatives are also 
calculated plus angles Yro and Ong for the case of trajectory X, Y, Z 
coordinates. 


4) ATMOS —Calculates atmospheric density as a function 
of altitude. 


5) ZRVALT — Calculates local gravitational acceleration 
and vehicle altitude above the earth's surface as a function of 
position. 


B. Input Data 


Each trajectory generated requires one set of input data 
cards which contains the following elements, punched according to the 
given formats. 


1. Title Cards. These are punched free field and are 
intended to contain a descriptive heading for the trajectory. The 
number of title cards is unrestricted; the last card must contain ENDT 
in columns 1 te 4 and blanks in columns 5 to 10. 


2. Trajectory, Option and Breakpoint Numbers. This 


card contains three integers punched in 315 format. The first integer 
is a trajectory identification number and must be an integer in the 
range 1 to 5; the second number selects the input data option 
(Paragraph VI.A.5) and must be an integer in the range 1 to 3. The 
third integer is the number of points in time (breakpoints) at which 
input data are provided; the range of this number is 3 to 100. 
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3. Euler Angle Indicator and Angle of Attack Data. 
This card contains up to eight entries punched in floating point format 


8F10.0. The first entry is an indicator to determine whether vehicle 
Euler angle interpolation coefficients are required to be output — a 
zero value indicates that Euler angles are not required, in which case \ 
the next six parameters on this care are unused and may be set equal 

to zero; i.e., only Bo is required. The remaining seven parameters : 


have the following meaning: 


dc, 


da 


Se ga ee 


= Lift curve slope (rad) 


a, * Expressed in degrees 


ss : cane ae Lift curve slope (rad) 
2 


s = Wing loading in appropriate units (Paragraph VI.D. ) 


fe) « Sea-level air density in appropriate units 


SL 
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Hor ™ Number of feet per unit of length in which the trajectory 
is expressed 


& ™ Sea-level gravitational acceleration in units consistent 
with the trajectory data. 


4. Output Reference Frame Transformation Data. This 
card contains six quantities read in 6F10.0 format and represent the 


i translation and rotation of the output reference frame. The data are 
Ep a8 components Xo» Yo» Zo in the same units as the trajectory and 


SEB ot tot ae 


Yo» Bq» $5 in degrees. 
5. Trajectory Input Data. All data are read with a 


format of 8F10.0. Card contents depend on the option number in Para~- 
graph VI.A. 2 as follows: 


(a) Option 1 — Each card contains two sets of 
data (except the last card which may contain only one set) containing 
values of time and associated values of X, Y, Z2 trajectory coordinates 
relative to the input reference frame. Time is required to be expressed 
in units of seconds and trajectory coordinates in units which are 
selectable by the user (Paragraph VI.D). 
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(b) Option 2 — The first card must contain the 
three position coordinates and three velocity components of the 
vehicle relative to the input frame, at the first time breakpoint 
contained in the subsequert data. 


Subsequent cards contain two sets of data, as in option 1, but 
each set consists of time in seconds and acceleration in units of g 
along the vehicle velocity reference axes. 


(c) Option 3 — Data for this option is similar i 
to option 2. The first card contains an identical set of parameters, ; 
and subsequent cards contain sets of four items consisting of time, 
acceleration along the velocity frame X axis and angles Ve and °, 


of the velocity frame relative to the input frame. Angles are required 
to be expressed in degrees. 


Note that in all three options, the number of sets of data con- 
sisting of time and three associated parameters is given by the third 
integer of the first data card after the title. Example sets of input 
data cards are given in Appendix B. 


Cc. Output of Results 


Results are output by the program in two forms. Trajec~ 
tory results, in which the piecewise interpolation coefficients and 
associated times are included, are output to logical unit 7 (TAPE7 in 
CDC 6600 SCOPE) preceded by the title read from the input data. This 
part of the output contains the following records, all in 80 column 
card image format: 


1) Title records identical to the input title 
terminated by a record conta/ning ENDT in positions 1 to 4 and 
blanks in positions 5 to 10. 


2) A record containing the trajectory number in the ‘ 
fifth character position and the number of sets of interpolation : 
coefficients in the ninth and tenth character positions. This latter 
number is always one less than the number of time breakpoints con- 
tained in the input data. 


3) Interpolation coefficients and their associated 
time breakpoint in the order Ag» Ay» Ag» 44» bo» b)» bo» by» Cor Cy» 


a? Pye Cy 
coordinate coefficients. Each record containing these data has the 
trajectory number and the record sequence number contained in the first 
five positions of the record in the format I2, I3. The remainder of the 
record contains interpolation data in the format 7E15.7 output as a 
string starting with the first time breakpoint set. 


Cys Cy, t where a 1 = 1, 2, 3 are respectively X, Y, Z 
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4) For the case where Euler angle interpolation 
coefficients are required, these results are output in identical format 
to 3) in the foregoing. Sequence numbers are reset to commence with 1 
for this set. 


The second form of the output consists of printed results which 
includes the input data suitably annotated, the interpolation coeffi- 
cients, and the vehicle trajectory at 0.25-sec intervals over the 
input time span. The printed trajectory is obtained by use of the 
piecewise interpolation coefficients. In addition, if the Euler angle 
option has been selected, the Euler angle and angle of attack input 
data (generated within the program), interpolation coefficients and 
interpolated Euler angles at 0.25-sec intervals are printed. Addition- 
ally, the resultant lateral accelerations (along velocity frame Y and 
Z axes) in terms of g are printed with the interpolated trajectory 
position and velocity data. 


Sets of example printed results are given in Appendix B. 
D. Dimensions and Units 


The program is designed to permit the user to select the 
physical dimensions and units of the final output trajectory data. For 
this purpose the input data must be consistent within the desired units 
system. Units must be chosen for the following input data: 


1) Option 1 position data. 


2) Options 2 and 3 gravitational acceleration and 
initial position and velocity. 


3} For the angle of attack option: Vehicle wing 
loading, sea level air density, altitude noraalizing 
parameter H ORM" 


N 
4) Output frame origin shift relative to input frame. 


Table 1 contains the units of each of the above for the British and 
SI systems. 


E. Error Messages 


The following crror message may occur followed by program 
termination: 


TRAJECTORY NUMBER OUT OF RANGE XXX OR TOO MANY SECMENTS XXX 


where XXX ure respectively the trajectory number and number of break~ 
points read from the input data. This message appears when the tra- 
jectory number is greater than 5 or less than 1, or when the number of 
breakpoints exceeds 1.00. 
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TABLE 1. INPUT DATA UNITS FOR BRITISH AND SI SYSTEMS 
Parameter British 
Vehicle position ft @ 
Gravitational acceleration 32.17 ft/sec” 9.807 m/sec” 
Velocity ft/sec m/sec 
Vehicle wing loading 1b/ft” kg (weight) /m- 
Sea-level air density 0.002378 slugs/ft? | 0.1244 kg (masc}/m> 
altitude normalizer 1.0 £t/ft 3.280843 ft/m 
: 


ee 
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LIST OF SYMBOLS 


Acceleration vector relative to the output refer- 
ence frame 


Components of Ay 


axes directions 


along the output reference frame 


Components of vehicle acceleration along the vehicle 
velocity frame axes directions (velocity frame from 
the input frame) 


Components of vehicle acceleration along the vehicle 
velocity frame axes directions (velocity frame from 
the output frame) 


Coefficients of the piecewise cubic polynomials 


Tridiagonal matrix of independent variable break~ 
point intervals for calculation of cubic spline 
coefficients [Equation (37)] 


Vector function of independent variable intervals 
and dependent function values required for calcula- 
tion of cubic spline coefficients [Equations (37) 
and (39)] 


Vehicle lift coefficient 
Operator representing d/dx 


Interpolated function representing f the true 
function 


Function values, to which the piecewise splines 
are fitted, at the ith independent variable 
breakpoint 


Df, 
Local gravitational acceleration (magnitude) 


Sea-level gravitational acceleration (magnitude) 


Gravitational acceleration vector in the output 
reference frame 


Components of gravitational acceleration along 
the output frame axes directions 


34 


Ta HAO eyes 


HORM 


h, (x), hy Gx) 


4, j, k 


L 


IT oy 
[Tl yo 


t 


(eJ, [t,), 
(t,], (ey) 


ee RS ee ee ENS ee ee pe YM Oe Le eee eee RAR ES eT eC ete ee es aie Ma 


Components of gravitational acceleration along the 
velocity frame axes directions (velocity frame from 
the output frame) 

Vehicle altitude above the earth's surface 


Units parameter: number of feet per linear unit 
of the trajectory data 


Cubic polynomial piecewise interpolation basis 
functions 


Integer indices 
Vehicle aerodynamic lift 


The number of independent variable breakpoints over 
the interpolated range is N + 2 


Integer index 

Piecewise cubic polynomial 
Piecewise cubic polynomial 
Radius of the earth 


Position vector relative to the input reference 
frame 


Piecewise cubic polynomial 


Translation of the output frame origin relative 
to the input frame 


Position vector relative to the output reference 
frame 


Vehicle wing area 


Direction cosine matrix of the output reference 
frame relative to the input reference frame 


Matrix of direction cosines between the output 
reference frame and the vehicle velocity frame 


Time 
Component transformation matrices which form 


[Tl 


35 


PR REELONRE Te 


V 


Yur? Yyr* Var 


Vere? “yrer Yate 


V0? Yyo? V20 


FET SES 8 SAE RYU TP a 


Discrete breakpoints in time at which trajectory 
data are given 


Magnitude of vehicle velocity 


Velocity components along the input reference 
frame axes directions 


Initial condition velocity components in the input 
reference frane 


Velocity components along the output reference 
frame axes directions 


Vehicle weight 

Input veference frame axes 

Coordinates relative to the input reference frame 
Components of Ep relative to the input frame 
Output reference frame axes 

Velocity frame axes 


Intermediate axes between the input and output 
reference frames 


Independent variable of the exact and interpolated 
functions £ and F 


Discrete values of x representing breakpcints for 
the interpolation process 


Aerodynamic angle of attack (magnitude) 


Angle of attack at which idealized lift curve 
alope changes 


Aerodynamic angle of attack with appropriate sign 
Difference between successive paire of £5 
Independent variable breakpoint intervals 


Piecewise independent variable, x ~ xy 
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Increment in vehicle Euler angle Vp between the ith 
and (1 - 1)th breakpoints 


Piecewise time variable for trajectory interpolation 
Kronecker delta function (O when i # 4, 1 when i = j) 
Lagrange interpolating polynomial basis functions 


Vehicle Euler angles relative to the output 
references frame 


Euler angles of the output reference frame relative 
to the input reference frame 


Euler angles the velocity frame relative to the 
input reference frame 


Euler angles of the velocity frame relative to 

the output reference frame (but with pp defined by 
the vehicle hank angle) 

Initial values of y T and@ > 


Definition of VB extended beyond principal values to 


allow first/fourth quadrant crosgings to be 
continuous 


Ambient atmospheric density 


Sea~level atmospheric density 
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Appendix A. COMPUTER PRCGRAM LISTING 
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PACGRAM TR» JEC THITH OPTH1 FIN Se2¢7438S O4/14/76 


PROGRAM TRAJEC CLNPUT » OUTPUT, PUNCH »T AFESSINPUT »TAPESROUTPUT, TAPE?) 
Gate Ben Dae Bie Be Om Cee Fa we Ga OE we Gata Ba Fa Ua Sie aE wee GaGa Oe Cab aba Sate Saba ta’ wha Be 
THIS FEOGRAM GENERATES TRAJECTCRIES IN YHE FORM OF PIECEWISE 
SPLIN: INTERPOLATION COEFFICIENTS AT GIVEN QREAKPOINTS IN TIME. 


TRAJECTORIES ARE CUTPUY IN THE #ORM UF SETS OF CUBIC SPLINE 
INTERFTLATION COEFFICFENTS REPRESENTING X, Vo Z COMPONENTS OF 

A RAI GCYORY TOU THER WITH THE ASSOCIAIc 3 TIMEe THUSe THERE ARE 
43 TEENS FOS EACH TRAJECTORY PCINTL 


TARGET INPUT TEAJECTORTES MAY SE SPECIFIED IN TERMS OF My Ye AND Z 
COME ORENTS JR AS ACCELERATION COMPONENTS ~ LONGITUDINAL, NORFAL 
ONC BADTAL = AS FUNCTIGNS CF TIME. FOR THE YVAPIOUS INPUT OPTICAS 
SE® THD PROGRAM LOCUMCNTATION. 


FLECUEWISE SFLINE REPRESENTOIIGA OF FYULER ANGLES IS AVAILARALE AS AN 
OPTION IN WHICH CASE ANGLES CF ATTACK MAY GE INCLUDED. EULER 
ANGLES ARE CALCULATED ASSUMING COORCINGETED TURNS. 


THE CUTPUT FRAME MAY dE TRANSFCRMED @Y TRANSLATION AND ROTATICN, 
FELATIVE FO THE INPUT DATA REFERENC. FRAMES 


CUTFUT OF THE INTERPOLATIO:N COEFFICICNTS IS TO UNIT 7 IN CARD 
IMACE FORMAT (12el4e5233¢8) WHERE THE Z YNTEGERPS ON EACH CARD 

ARs TEABECTIRY NYUMAER (1 TO &) ANDO A SEQUENCE NUMBER. COEFFICIENTS 
LEO It THE CROER ACy Als A2veoveeT AT EACH POINT. 


AeCo JOLLY, DECEMSER 1975. 
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GIY: te TOM TRA SCL ICID), XTRAS 0128795 XYZ£3,100) 
Cie? NS LON LAGELCO)s TIME (130) .7M (3,3), x¥Z0 (3) 

CUE VALENCE (TRAIEXTRAS) 

CIMENSIOW K(LOC), MLAM (10 DP eXMUCLOODs PLLTIb. Qa(190) 
1 eXMOLG0)» A2C3y 1900) ,43 03,206) 

GLHE HS FON VOL (100), VON(100?. VORI10G) 

CONCH /2KTGTS VT" FSIT, THET, RTS (306 vTid3) 
cornar “Tots TTME, RT i3)¢ VT (3) ANGL(3)e ACCS) 
GATE RTO0/57,295 7795/4 PI/3eL41 5926547 

CATA TWOPI/6e2831 8535187 


Pee TNTEFRCLATICN STATEMENT FUNCTICN 
FIATOACC TINT, TS? «= ALLCT SP OTINT* (ACC (TJ+4) ACCT SDD 
eee READ ANDO OUTPUT TRAJECTORY TITLE. 


[oe ks) aoOao 


NPAGE = 4 

. KEITE (695973) NPAGE 
PAGE = NPAGEoL 
LINES = 3 
NEASES = 3 


i rE AC 25935) LABEL 
IF (20F 03) NECCIGO TO 1909 
WRITE (646931) LA3ZEL 
LIOrS = CIMES+1 
WRITE (7-930) CASEL 
T©@ (LS BEL CLD NES LONENOT G0 79 4t 
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(a Attach Pn! 
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IROGZAM TRA VEC PHT S OPT a4 FIN Ge2e7%ak55 SHFALGSTS 


bo © 121,99 
© WRASCL SID = m10E6 


els eG 


e¥e REAC T<AJECTGRY NUMBER ANO TRAJECTORY GENERATOR OPTION AND 
NUERBER OF YRAJECTORY POINTS (UP TO A MAXIMUM OF 21) 


cay, 
Ase, 


Qaan 
oo 
* 
2 
es 


READ 029919) LTRAJs SOPTANSEG 
WRITE (6.890) ITRAJ, IOPT. NSEG ‘ 
LINES 2 LINESe3 ‘ 
IF CITRADe LCoS eAND, ITRAI GTO 0D ce ANOONSEGOLE 2100150 TH 2) 
WRITE (65927) ITRAJ, L0PT, NSEG 

st¥cy 


ove FEA ANGLE OF ATTACK OATA 


i Aaa 


Gog 


2. CPEAND 64,940) ALND, SLOPE Le ALF AL SLOP E25 HOS, RH OSL» HNORM: GD 
IF CAZNDeNE Oe WRITE (695508 SLOPEL,ALFALs SLOPE2, WOSe RHOSL »HNORM 
IF (AI NO,NEQeILINES = LINES o& 
AL FAL = ALFAL/RID 


oda 53 os ek 


*** READ FRAME TRANSFORNATION DATA FOR TRANSFORMING TO THE OUTPYT 
TRAJECTORY FRAME. TRANSFCRYATIUN PARAMETERS ARE TRANSLATION ANDO 
ee ROTATIUN COMPONENTS, THE LATTER IN SeGREES, THE FORMER IN 

*e* COKSISTENTLY APPROPRIATE UNITS. 
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BLES €>99G0P X¥Z0— PSIGe THEI), PHIG 
HPITE (6,849) KYZC, PSIO, THETCs PHIG 


i aletenaae ei 


WRITE £6,395) A 4 
LIKES = LENES#?7 a r 
GO T0030.59.50 10PT id j 
Cc — ‘4 
C *** TRAJECTORY INPUT AS A SERIES OF X» Ye Z COORDINATES a : 
Cc ~~ Ma 
3° ACAKCE = NSFG/2 3 4 
IF (NCARDS*2eNESNSRGINCAROS = NCARDSo4 f 4 
CO &C I21,NCAROS 4 | 
Je 2°(L-1) 94 Fy 4 
FE AD (25940) TIME CID» MV ZIL ed De XVZO2edde KV ZS eID : “ag 
1 TIME CJOAd XYZ ty dei ds KYZ( 2, SOL), XYZI SUL) ! Pe 

BRITE (698819 TIMEC ID, XVZIL gS) XY ZIZ2 pd yg KYZC3 Sy : 

1 TIME CJetd es XVZ Cty det) so XYZ(2e Sedan KYZI3, Jt1) 

LIN'S = LINGSe2 
&. CONTINUE 


GO IC 173 i 


#*P OPTIGH 2¢ LONGITUDINAL, NORMAL AND HORIZONTAL ACCELERATZINS CIN 
eee Ges) ARE INPUT FOR EACH OF NSEG FLIGHT SEGMENTS. THE ACCELERATIONS 
wee ARE CEFINED IN A TARGET FRAME WHOSE AV@-AXIS IS THE TARGET VELOCITY 
*** ANO WHICH DOES NOT ROLL WIYH THE TARGET. ACCELERATIONS ARE 
INTFGFATEO IN AN INERTIAL FRAME TO VIELO THE TRAY=CTORY CF 

*** POSETION DATA TO WHICH THE CUBIC SPLINE iS FITTED. 


eee FIEST x€AO TARGET INITIAL FOSITIO# AKD VELOCITY IN THE IPERTIAL 
ous FRAME 


HOorraan0o0aan 
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5. FEAC €1,965) TO, VIO 
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: SLE TLE TYTN ONS TFET LT TY STOR, FTO TET PETER ATE | EPR NNCTSy TN NPT EY TENT TI, ROTH ET FR ETRPOTT THEN TT TY TER NPC UEP UME MTUTE TO NTI 


PROGRAM TRASEC Ta/7e OPT*% FIM 4e2¢Tayss One L977 


ei aie Br a 


C #8 NEXT THE SETS OF ACCELERATION COMPONEETS AND ASSUCIATED TIMES 
G 


NGARES @ MSEGZ2 
; LF CNCAROS? 2 NEANSEGINCARDS @ NCAROS+S 
CO FC Tela NCARDS 
i: Jos 28 Lap don 
i FEAD €2¢9G7) TIMECI2 6 YORC SI, VORG ID, VONG I), 


Reve 


oe TE nasee 


2 4 TIME (SOLD, VOLT IO 2)» WOKE SLD. VONCJ OLE : 
i WOLTH (6.087) TIME ID» VOL Wt, VOR CUh» VON GD» 
’ 4 (LHEC TOLD» VOLGSi) e VOR (JOSE, VON( SOL) 
UXPES & LINES? 
Bo CONTINGE : 


TF CLOPFLEQ.SIGO FO 140 
Ae CALCULATE TARGET INITLAL CONUTTIONS 


aoa 


TEPPA & VTOGLPOUTOCL DOV IG C2) Y¥ TOC) 
VOT s SORT CTEMPLOVTOG3) STOO 3) 

; PST = ATANZEVTOS2? eYTOCEES 

i THEY  ATANZCWTOCT) PSGRTITEMPL)D 

: A: CONTINUE 

t X¥2(ie1) 2 PTOELD 

4 KYZC2019 = R722) 

KVZCSe Ld * RVOL? 


eee GIVIGE EACH TIME SEGMENT INTO 19 STEPS FOR INTESRATION AND 
ee~ CALCULATE TARGET POSITION BY RK=% NUMERICAL YNTEGRATION. 


Oana 


! Jue 2 NSEGeL 
4 oO AC Lal, fuP 
: OELT = TEME Ci eL -TIME(TS 
OY = OLLTsi10. 
Ye TIME«T) 
CALL GHVALT (GO sRTIyHNORM,G ALT) 
VOLONG = G*VOLEZ) 
VONCRA ® G*VONCI) 
VOFADL = G*vORCT) 
CO 70 Jui,tO 
IF (XG#T.EQ,39IGO TO 70 
TINY 2 CT*TIMECLIISOELT 
VOLONG = GEEINTCVOL TIN TP 
VORACL = G*FINT (VOR, TINT, I? ms 
VUNOKM bw GYEINT (VON TINT ol? es 
7 CALL FKL (VOLONG, VORADL» YOKCR Ms TyOT) : 
XY¥Z¢LoToid = RTOULI 
MVZiSe el) 2 WIG62) 
8. MVZC3,IeoL) = RTS} 
GO ¥T £73 
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eee CPTION 3. TRAJECTORY OATA ARE SPECIFIEO 4S LONGITUDINAL ACCEL~ 
ERATZUN, TARGET FRAME PSIT AND TARGET FRAME THET 4S ARBITRARY 
*e* EUNCTIONS OF TIME. PSIT AND THET FUALTIONS SRE CONVERTED TO 
*9% EQUIVALENT ACCELERATIONS WHECH ARK INTEGRATED AS FOR OPTION 2. 


ocoaan 
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10° «=PSIT = VIR GLISRTO 
THET = VINCLI/RTO 
vTT = vTdt1) 


PREGRAM TRA WEC Pasty OPYst 


wey ERE EET NR RTT FoR FRET Cee err peprrregmyte ss sas 


ii. 


Oana 


oo 


FIN 42074355 


M§:rG = NSEG=1 

CALL CSVALT(GOeRTC eo HNORMGeALT) 

OO 4a. ITs1,PStG 

OT « TIME (TesveTIMECT) 

WTT = VITSOT®.5*CVOLCT) evOLC T4109 SG 
Yo TM a eS *CVONC IPO VONCITeOL I /RTO 

QA = VITZCOTPERTO*G) 

7F = QA*EVONETeLPeVONCIDD 

CA = QASCOSCTHETH) * (VOR (T4329 -VCRiID?) 
VORCZ) = QA 

VONCLIP © @2F 

CCHTINVE 

VOR(NSEG) = 0, 

VORKENS Gb os Os 


CALCULATS TARGET INITEAL CONCITIONS 


VTT = v7Te1) 

VILELE & VYTPOCOSCTHETI*COS (PSIY) 
VT.02) = VT TSSING@THETD 

VTL O38 = VTITSCOS(THETI*SINGPSTT) 
GO TOC uv 


TRALSFCRM TARGET FOSITION GUORCINAT:2 TO THE OUTPUT FRAME. 


CST = COS(PSILZRTO) 
SSI = SINCPSTIO/RTOD 
CTH = COS(THETG/RTO) 
Stu = SIN(TRETO/RTO) 
CFI = COS(PHIS/RTC) 
SFI = SInN(PHLloOsatoo 
TM(t,t3 = CST*CTH 
TM(2928 = STH*CSI*SFT-SSI*CCT 
TM(3ohd = STH*CSIFCFICSSIFSFI 
TM(L92) = CTW*SST 
IH(252) = CST#CFHI+STH*SSI* SFI 
TH(392) = STHFSSI*CEI-cSI*SFT 
T™H(1,3) = «STH 
TH (2,3) = CTH*SFI 
TH(7,2) = CTH*CFI 
00 19 TsisNnS€G 
0G 16. Jd=253 
 PYCEIP = XTZEV eT PX VZOCS) 
60 39° J=hs3 
XVZUIe dd = TMCLDFRTICARE TN (Se2PERTU C2) TMC Sy SE PRES OSD 


NOW CALCULATE Cu3IC SPLINE COEFFICICNTS 

CALL AVELINITIME XV ZyNSEG 6 Se Me XLAMy XMU gP gQaXMeAZeATHTRAS) 
FRIMT INTERPOLATION COEFFICIEN’S 

MSFG = N3EG=1 

WRITE (6,833) 

LIFES = LINES*2 


00 26¢ T21,MSEG 
WRITE (65820) TRAICL IT pC TRAIUSe 1) pest 2t 


43 
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artes 


Ra arn ee he A OG ETAT te ee Per apn eee 


jai ecrng ot ae 


ak at ogo Re; 


FR eal Se A et 


Se ees, 
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RUT TURRET STE TER ONT NTT TRAN TEEN ms TIE TE SVE ALE TET | FEU A TF RPT ETON SY 


PAOGRAM TR. JEC THI? GPT a4 FIN 4. 2¢74355 


can 


ei 


ace 
2ce 


2aLe 


LINES & LINESS4 

IE CLINES.LT.S5960 TO 230 
WRITE (6,872) NPAGE 

NPACE 2# NPAGEFIL 

LIngsS = 3 

CONTINUE 

LINES @ LINESE? 


CUIPUT THE INTERPOLATION CCEFFICIENTS AND TIME TO UNIT 7 IN A 
STPING STARTING AT TRAGCLeL? PLUS TRAJECTORY AND SEQUENCE 
KUPAERS ON EACH CARO. 


MS-G = (NSEG~i1%23 

Izi1 

wSsetQ = i 

Jot [ty 

IF Ode GY eHS2G) VEMSEG 

WEITE (7,953) ITRAS, ISEQ, (XTRAS(KIK eID 
Tz Jel 

ISEN = TSEQ¢1 

IF €JeLTeMS7GIGO TO 210 


GENERATE TARGET POSITION AND RATE TIRMS AT 1/4 SECOND INTERVALS 


TTVE = Oe 

or = .25 

JUF = TFIXITIMECNSEG)/0TIO2L 
HRITE (659635) 

TF UKE ASS -EQ.IPWRITE (6,979) 

TF (NF ASS ONES CIWRITE (6.9759 
LINES = LINES+1 

CO 22° EsieJUP 

Catt ATTAKI(TRAY) 

CALL GAVALT(GOsRT eHNORM,G, ALT) 
CST = GOSCARGL(1)) 

SSI & SINCANGL OLD) 

C¥H = COS CANGL(2)) 

STH # SINGARGL (25) 

YACC = -ACC(1)*SST+ACC(2)*CSTI 
ZACC = ACC CLI YCSTESTHOACC( 2) *SST*STHEACC (3) *C TH 
VACC = SORT CYACC*®YACC#+Z ACC *Z ACCI/G 
PSIT = ANGL(1)*RTO 

THET = ANGL (2) "RTO 

If (NF ASS. EQe0IWRITE (659808 TIMES RT eVT sPSIT,THET, VACC 
IF (NFASS.EQ.09IGO TO 236 

00 2t2 Jz1.3 

RTGS) = ITC I) *RTO 

WTC9d = vTCIPFRTO 

WRITE (65995) TIME, RT. VT 
COATINUE 

LINES = LINES+2 

IF (LINES sLT.60IGO TO 215 
WRITE (6,875) NWPAGE 

PAGE = NPAGE*4 

LINES = 3 

COwt INVE 

TYPE = TIMESOT 


SD ee Sad 


_ at a at tel ANN ee te 


WesLes7: 
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4 
4 PwOGRAM TRAJEC 7usPa OPT #3 FIN 4o2¢ 74355 THs LUs? { 
q i 
a 22 9 CUNT NUE | 
‘ WRITE (6.999) 

LIKES = LINES +e | 
: IF (LINES .LT258IGO TO 225 
a WRITE (6,675) 
P “ LIS = 3 
OU 22f CORTINUE 
. y v Cc 
: G 8** CALCULATE TARGET EULER ANGLES INCLUGING ANGLES OF ATTACK. : 
ee G *#* TARCET LIFT COEFFICIENTS ARE CALCULATED FROM LIFT CURVE SLOPES 
= CF AMC WIKG LOADING. 
1 Cc i 


TF (AIND.EQ20.960 TO & 
WRITE (6¢660) 

LINES © LINES e6 

CALL FLSETI(TRAY) 

NREW = Q 


ate. 


a 


j 
YACC = (GXQ-ACC(1))*SSI* CACC (2) -GYG)*CSI ] 
‘ZACC = (GKVACC( 19) SCSI*STHe (GYO=ACC(2 9) *SST*S MH (GZ3+ASC (30) CTH . 


CO 23 Iui,NSEG i 
Tr! = TIMECDD ‘ 
eS CALL ATTAK (TRAJ) \ 
Ky. CALL GRVALT(GOeRT »HNORMyGyALT? i 
4 f CALL ATMOS (ALT pRHOSL RHO) p 
FF GAs 06 *RHOF(VTELD SUT CLD OUT C2) SVT C2) ove (3) OT CID) { 
4 i C #9 TRANSFORM GRAVITY TO OUTPUT FRAME \ 
, G 4 
Pe GK = USTH(493) g 
a: GYS = S*TM(293) i 
i GZ. & G*TH(3,3) 4 
_ c 
a; C 4** THANSFCRM ACCELERATION AND OUTPUT FRAME GRAVITY TO VELOCITY FRAME 
- & c 
BOS. CSI = COSCANGL(LDD 
& SST = SIN(ANGLE E15) 
LTH = COS CANGL(2)) 
; STH = SINCANGL(20) 
ke 


ts 
ean 


IF GAAS (ZACC) ol Tol.€°30IGQ TO 235 
ANGL(39 = ATANCYACC/ZACC) © 
GO TO 238 
235 ANGLES) = Je 
234 COAKTINUE i 
ZF = WOS*SQRTCYACT® YACC+ZACC*ZACC IG i 
i) 


a 


ALFT = ZF/QA/SLOPEL 

IF GALFT.LEALFALIGO TO 240 

ALFT = ( ZF/QA~ALFA1L*SLOPEL) /SLOPE2*AL FAL wen 

24c IF CZACCAL Te Qe DALFT = ~ALFT i 

CFI = COS(ANGLE (39) - 
SFI = SINCANGL(3)) ‘ 

Cat = COSCALFT) 

SAL = SINCALFT) a 
XVZ(1—eL) = ATANZ CIC THPSSI*CAL“STH®CSI*CFI* SAL) p(CTHFCS I®CAL@ eo ed 
1 SST*SFI*SALD?) o Poe ee 
X¥ZC2_e 1) = ASINISTM*CAL*CTHECF I*SAL) 

XVZO3_ 1) 3 ATANZ(CTH®SFI. (CTHTCFIYC AL=STH* SAL)? 

st = x¥Z(2,1) 


aoe ee ate 
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69¢e 
89° 


9a: 
Qe 
92. 


Se. 
93 
95%. 
gt 
SEE 


97: 
97° 
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98: 
99C 


PROGRAM TRAJEC 


99° 


IF G2 LTO ESE © SL+eTHuPt 

If (1.¢Q.21G0 1 248 

28 oz SlaSTPR 

TF CZF .GTePLINREV & KagVod 

IP GZF LT OE LE MRE oF NERC VOL 

cree » St 

MY¥ZC4, 78 2 SYONREVE T HORT 

PSIT o C¥ZCLATIERIO 

THET © KV2CS,T PORTS 

FUT m cede held eriD 

ALFY = ALE TPRTO 

WRITE (60995) TOME SPSST THT FET. AL ET 

LURES & LINES SR 

TE CLINE SALT .6GIGO TO 236 

HOTTIE (By ATS) WRAGE 

NPAGE = HPAGESS 

LINES 2 3 

CONTINUE 

AIRY = Ce 

PPASS 2 4 

GO TO 203 

WRITE (6.963) 

stce ‘ 

FORMAT (15X Fided, FUGCSX ELSA ASHI?D 

FOTMAT (2H9, 47% SIKSPLINE INTERPOLATION COEFFICIENTS? 

FORMAT CAND, SOX S7HOUTPUT FRAKE TRANSFORMATION, 4 AVK 2HXG_ 17K 
L 2h¥ig L7X ZHI, 16K GHPSILCDEG), 9X ROMNTNETC COEG), 10% INPSTC (DEG 
Zhe 73% GF1L9e2) 

FOF MAY (1HO, SOX SSHEULER ANGLE INTERPOLATION SELECTED, ¢ 19K 
L DHECCL/OAD Ly,» 14X SHALFAL® LIX GHCOCL/OAI2Z— L6X 3HW/Ss 14% SHRHOSL 
2 9 14X EHMNCRM, 7 WEEK FLt3by FCIK FACS 

FOSMAT (77 4OK ST7THEYLER ANGLES ANO ANGLE OF ATTACKADEG), 7 %2X 
1 SHTIME, BX SHPSI, GX SHTHETA, 8X SHPHY, 7X GHALFA! 

FORMAT (1Hi», 36% SSHTRAJECTORY GENERATION BY PIECEWISE SPLINE INTE 
LEPCLATION , 37K SS C1H9), ISK GHPAGE, IS 7) 

FOSMAT (43% &FL2 63) 

FORMAT (4K0— 4 30K ATHTRAGECTOPY NO, = , 22, 10K LIMOPTION NO. = , 
& I2— 25K 22MNO, OF BREAKPOINTS = » 13? 

FORMAT (4/ SOK L2MENPUT TABLES, 7 £.X GHTIME, SX GHX COMP, 4X 
i EY COMP, 4X 6HZ COMP) 

FORMAT (2UX A9CLH8)s BALD, LO0RH9)) 

FOFMAT (315) 

FOCHUAT i7/ 28X * TRAJECTORY NUMBER CUT £6 RANGE*, 2X 8, *OR TLS “1A 
LNY SEGMENTS® 2x I8) 

FOFMAT (3F 10.3) 

FOSMAT (3A10) 

FOWMAT (T2, 339 $€19.8) 

FORMAT (7/ 20X *2END OF RUN®) 

FOSMAT (77 3OX 72HINTERPOLATZO TRAJZCT CRY BATAULINEAR UNITS FRCM TI 
1NPUT, ANGLES IN DEGREES) ? 

FORMAT (15X GHTIMEs LUX LHXe ALK LHe LAX LHZs 9X GHXNIT, 

LEX GHYDOT, 3X GHZDQT, BX GHPSIT, 7X SHTHETAT, 4X AIMLAT ACC(G)) 
FOSHAT ¢€ 27x GUTIME,LOX GHPSIT, 8X GHTINET, 8X GHPHIT, 7X 

1 SHPSI TD, 7% SHTHETO, 7X SHPHITO) 

FORMAT {7X 6.3, $12.3) 

FORMAT C3ISK S°L2.2) 

FOSMAT (77/7) 


FORMAT (24N 7F2202) 
EMC 


4é 


OPT2\ FTid 902074355 cases? 


Siig iste TSG 0 ea 


THITS OPT=1 FIN 402%74355 Q4/ 14/7 
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A PTET OTR Feee ey ee a, 
sth i OR TR TTY IRR TY CT TEL TENA VEASTE ITE PPR TTT NYSP TION eb ORES Te a IA Wigtabarine 
pees Y Pa TORIC ADR Tens org tee Te 


; PSS EU US TTREE, (A PLETE gt TE ery 
u 
Bye ASSO RN UTR SORE ERE OR Te att rege parte, de eerie a often ret ; 
ay 
Na 
‘ 
“3 , QUUTERE AY. LTb Talia OPptst CIN welt Te 355 Wasiss7 ; 
a CUBR CUTYNE AVELINGTIME oXVZ oN NV oH oXLEM oXMU oP eQeX Mo AZ ah Sy TRAI) | 
. " Cu Oo ta te On te Oa Fe Bhat ad baat aba Sah nd at oF a Hn Baba tanta bode beda date tnteta 
Br. a C IHIZ SUBROUTINE CALCULATES SPLINE INTERPOLATION CORFEICTENTS 
" % C TO EIT THE Xy Vy Z COORDINATES TRANSHIITED IN ARQEY XYT~ { 
- : Cc TH. PUMRER CE SETS OF DEPENDENT VARIABLES IS GIvEMW BY NY ANO THE ; 
a we G hUMBER OF BREAKPOINTS IN THE INDEPENSERT VARIABLE IS Ne 
4 4 a ee eee eee ee ee ed eee 
BY & GI eens LON KYZC3TeZAPe TRAVELS 2 3 Hibs XLAM(1), 
7 : 1 KMUTADe = PC ADs QUa). KM CHV LD, AZCNY aD» ' 
a 2 ABCA Ad, TIME CL) : 
J c : 
4 C **® CALCULATE INTERVAL IN THE INCEFENDEAT. VARTAALES \. 
a vo € Ks2_N i 
a 3 hOKD = TIME (KD aT ibe (KL) % 
Bi G i 
a i C *** CALCUL:TE CONDITIONS AT THE EXTREMITIES. k 
4 iy c if 
q th ise A 
a s Jz Fi 
7” if Kis 48 s 
i. 4 Lo XQ = TIMCCL@2) 4 
i ee XL = TIMECT) i 
a & v2 2 TIMECT OO) i 
o KP F KOOL ; 
; KL2 = KAYXE t 
X22 = X2*X2 Q 
Ho = HCD) ity 
HE = K28K4 4 
n2 2 htleda) “a 
C = Le SHI7HLIH2 ¢ 
CL = 2.°TIMECO) i 
CO 2. [¥s1eN¥ 
Yo = XY2¢IV¥,I-1) 
Yi = XV2CTY41) 
Y2 t XV2CTY,T#4) 
BL = CLAYTON S2HCVZ-VED XLT ECV 2~YLI EXO 
B2 = H.*V2rHi*Vit+h2* V0 
2° WMCLY, 9) = 9" (81482 "01) 
GO TGC 30,409K 
3 I = Kel 
Jjozh 
K =2 
GO TC 15 


¥*8 CALCULATE LAMGA, MU, P AND 9 


Qao 


wi. Q41) = 65 
IND = Nel 
UO SL K=2,I1N0 
MEAN CKD = HOKOLD SOHO KD4H KOLO) Le 
XMUCK) = LeeXLAM(K) ; 
FCKD = LoS UXLAMC KDE QIK 1) 420 

5. COOK) = -XMUCKD FP CK) 


#48 CALCULATE Cy U AND M 


aan 


TREAT Se RT ETIIRNN PEN RTO ITE RAT TS INTO ITS 


ce FRUMH ea SETTLER TEE UTNE LAE TEL TRAY EIR MEET NT PY RRR FOR GT ATTY 


ROUTINE AVELIN THT Opts, FIM bo 2476335 O4/44/7 


et 


¢ eae 


ig 
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104 


OO 70 LY¥st NY 

AZiTV, 15 = RCT Y¥,2) 

THO * Not 

09 66 Ka2,IND 

GR we SF EMLAMCHDFIKYZETYV ROOKYZEL Ve Ko LASS IK) OXMU TKD © 
UMVZEEY Kerb oXVZ CTY KK DD 7H (K42 DD 


a 
ASCIV,K) mw CGRONLAM CKDFAZCIV Koth DOR IK) 


€ = Ned 

00 YC K#s2,IND 

BMCIVe 2 & QCD FKXMC TY, KOL) CAZCIY,K) 
Kw Kez 

CONTINUE 


CALCULATION OF POLYNCMZAL COEFFICIENTS 


Ou Of J*4, INS 
Ul» HCO) 
UL2 # Le/UL U1 
UL = UL2sU1 


-00 @C I¥71,NY 


VO = KVZCIV, SOL OXY ZLOTY) 
XO = KMOLTY» JoaPOxMC IY, Jd 

MA © XOKMCT VY, DD 

AZCTVe SP © U2" 6 Se* VOULX 4A) 
AZCKVs 3) = ULS> (UL*XO"2.*V 09 


STUPAGE OF COEFFICIENTS IN ARRAY TRAJ 


TC = BONY ot 

00 21CC K22,N 

J 2 «3 

DO 90 Is1,NY 

Jo= Jes 

THASCI Kid & MYZ(I g K-41) 
TRACES Ket) = XMCLyK~1) 


VRAIVI+2e Kot) = AZIT,K*1) 
TRAIII+3 Kei) = AICI Kea) 
TRASCIND sK~-1) # TIME (Koi) 
RE VURK 

ENC 
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ROUTINE RKS 


SERS REY CAT ieee cect] tha] ee ef ec ee 
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THIS SUBROUTINE INTEGRATES THE TARGET. ACCELERATION AND VELOCITY 


TO GIV< DISPLACENENT IN AN INERTIAL FRANEs ACCELERATION COMPGNENTS 


IN THE TARGET FRAME ARE CONVERTED TO TRE YARGET VELOCITY AND 


TARGET FRAME EULER ANGLES PSIT ANO THET. 


(1 Sa ¥an Fa Fe 8 Fn $a BaD oP ee Beh OF 2B bo Fn Ge Sa FE aS oF a Oe So ¥ oh ead utwd eh ub an Fadotea 


COMMON /RKTGTS TST (bbe ¥T U3) 
OLMENS TON Alb}, St6), 
DO bE Kei es 

yacctz) = VOL 

CYMET = COS(TST(3)) 

T® (CYMNETL EG8.6.960 70 § 
YACC(2) = VORSCTHET/TST (1) 
TACT 43) = ~VONSTST(1) 
STHET = SIN(TST(3)) 

CPST = COSC TST(2)) 

SPSI = SINCYST (293 

VVC) = CTHET*CPSL*TST(1} 
VVQ2) 2 CYIMZT*SPSI“TSTCL? 
VT (39 = -STHET*TST (1) 
TACC(6) = VTCL) 

TACC(E) = V2) 

TACC(6) = VTC3) 

GG 10¢16,20,50,30)% 

OO 15 [21,6 

Tare = TSTCE? 

S¢Id = TACCCID*OT 

TSTCID = TSI(Lde¢.E*S (I) 

GO TO 49 

CO 2¢ 2196 

ACID = BY" TACCII) 

SCly = SCL) 02.9ACT) 

TSTEID & TCID+,5°ACT? 

GO TG +6 

00 £5 iaie6 

ACID = OT*TACCCI? 

SCT) = SCTD¢2.°ACT) 

TSTCI) = TCLV¢A(T) 

60 TO 46 

OO 35 [21,6 

JSTCIS = TALIS (SCL) +OT*VACCC ID) 6. 
CONTINUE 

YIme = TIME*OT 

RE TURN 

ENG 
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ROUTINE ATT AK 7OPTY GPT#1 FIN Go2¢74355 0471477 


SUGROUTINE ATTAKCTRAU) 
Ba Bo Bw Gm Bae Fa Be Fe Swe Soh Hi Ba B aw Gum Ga SE oh wh oh we Bw hy Ba Satiat wate ta bala hatea®a 
YMIS SUBROUTINE VETERMINES TARGET PCSITION,. VELOCITY AND 
ACCEL RATION AS A FUNCTION OF TIME aY CUSIC SPLINE INTERPOLATION 
FRE@CALCULATED ITHTERPOLATICN COEFFICIENTS 
ARE STOREQ IN ARRAY TRAJ. 
Bw Oe Gen Fe Ve Ce Ge Fw Pate tate Fok w¥a Ga Fa 8 eS oF 24 we Fate Gab aPataetuSa Ba Bata BaGa bw 
Bek CIMENS TON Cl12), TRAJ(L3,29) 
a COMMON /TGTs TOISFL, ¥(9), Acct) 
: OATA KEEGS IS 
‘ Tai & TOISPL 
IF (CTEASULI KSEG) -EQe-t -0EGIKSEG «© 14 
‘ Le TF ATA LT TRASKL I ,KSEGPIGO TO 28 
. TE CYL LE TRAJILISKSEG+199G60 TO 39 
IF (TPhAICL 3 KSEG 01) EQe~1666IGO TO 30 
KSEG = KSEGeL 
I@ (KSEGLT.269G0 TO 10 
KSEG = 23 
GO TO 30 
2c KSEG = KSEG-1 
IF (KScG.GE219GO TO 10 
KSEG = 1 
3G 4600 &C Int,i12 
&C Chid @ TRAJ(S eKSEG) 
va 2 TOLTSPL-TRAJ(13,XSEG) th 
T2 = TL®(CCZPOTLEC(G)) “ 
T3 & FiLF(C(7deTL9C( Od) a 
Te = TLS(CCLLD OT A9C (120) 2 
Y¥CLd w COLDETL9(C C20 46T2) i 


aQOaaaaY 


Sait Sie: 


YC2) = COS) eT14* (C16) oT3) 
Y¥C3) = CL9DOTAF(CULOD eT a? 
; Vosd = C2} eT2eT 2473 CC 4) t 
' V(5h © CCODETIST ICT L °C (GP : 
” YCED w@ CCLODMFTHOTOSTI9C (12) : 
YO7) = ATANZCYCSD 6 C4) j 
YCBY = ATAKZC~¥(6), SQRT CY CAD PY (6) oY C5) OVC DDD 
yt) = 6, 


ACCEHLD B 2. 9C(3D 66. *ClOd FTL 
ACCH2]) = 20°C(7D 46. C180 FTL 
ACCES) # 209C(220 96. 9CC42) O74 
RETURN 

ENTFY RESET 

KSEG = 1 

END 
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ROUTINE ATHOS TU/7% OPT st FIN %e2¢76335 04/1447 


Te , SUBRCUTINE ATMOS (H,RHOSL RHO) 
CaF a Fa Oe a On Be Oe Fa Bad es Fa Ow BO Ves Fa be ba ba Hohe Vo be Bi debe Fan ba Baba Bala Volante 
Cc THIS SUBROUTINE CALCULATES ATMOSPHERIC DENSITY AS A FUNCTION 
c OF ALTITUOE. DENSITY TABLE IS NORMALIZED BY ITS SEA LEVEL VALUE 
C SO THAT OLHENSIONS OF RHO ARE THISE OF INPUT PARAMETER RNOSL. 
c THE ALTITUDE TABLE IS NORMALIZED INTG UNITS OF 4000 FEET.I® TARGET 
Cc ELTITUCE IS EXPRESSED XIN METERS THE FARAMETER HNORM IN THE MAIN 
C PROGRAM MUST BE 36280843. 
c 


Fw Bua Fw Ber Ga BaF a FaF ao Va Ow Eo Beh a Ban Ba Ga Fa ¥ oS oF we Fate Feb ata aha Bate Babiana tata 


CIME NSIC ALTTB(32) ,RHOT BC 32) 

CATA ALTITB/ Jes Lee 2ee Joe tos 
i Ses Ges Tae Bes Yer 
2 Les l2e, thas 16.9 L8ey 
3 2068 22er 24a 2608 28es 
4 30ee Bley Saoe Joes Oe, 

c *6en 50e, b0es rare S00 
€ BDeoe 100./ 

LATA RHOCTB/ Les 097138, 094276, «91498, 2 869055 
1 266195, «83586, 81062, 078627, «76221, 
2 073864, 069318 065025, 0609463, 0570239, 
3 053325, 249790, HESS » «43308, «40320, 
4 «37683, «34806, «32273, «29891, o2u7inys 
+ 018544, 0153511, 0094865, «I588AL, 2036532 
€ e023089~ 221327 


, 

HE = £398¢H)71000. 
CO AC f=2, 32 

IF CHILGS.ALTTB(I=3).AND. HIeLEALTIB(TI9GO TO 2n 
ac CONT ILUE 


I = 32 
2: RHO = (RHOTB(I-2)¢(RHOTB(I D-RHCTS (I -2) DS CHI-ALTIS(I<“2)) é 
2 JIALTTOCII-ALTTB(L-299)9 *RHOSL 4 
EWC 4 
ROUTINE GRvALT 74/74 opt =4 FIN 422674355 C4s14/7 : 


SUBPOUTINE GRVALT(G0, Rs HN» Gy ALY) 
Cc Dw Fa Ge Fe Fn Fm Beh FA Fh oh wh oF Fe Fa Ee Ba E mB ab ew Saha Fa Gad a Ea Ba Be Sw Fa ta Saha da 
c THIS RCUTINE CALCULATES TARGET ALTITUDE ABOVE THE EARTH*S SURFACE 
c ANC THE LOCAL GRAVITATIONAL ACCELERATIGN ASSUMING A SPHERICAL 
c LAXTH OF RADIUS 20.566 FEET. 
C 


eee ee eee he ee eh he ee he het eee ee 


CI FE NS ION R13) 

DATA RO/ 20.89. 32EE/ 
GSC = (ROORC3)7HN) YF? 

GPR = (R(1) R61) RO 2) 4R02) DEHN THN 
ALT = SQRTI(GPRERSQ) -RO 


G = GLFRI*FROSRSQ 
END 
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Appendix B. EXAMPLE TRAJECTORY RESUcTS 


This appendix contains a set of trajectory results corresponding 
te each of the three input options. In each case the Euler angle option 
has been selected. The first two trajectories are expressed in SI 
units and the third is calculated in British units. 
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